The Furuta pendulum, or rotational inverted pendulum, consists of a driven arm which rotates in the horizontal plane and a pendulum attached to that arm which is free to rotate in the vertical plane (Fig 1).
Contents |
The Furuta pendulum was first developed at the Tokyo Institute of Technology by Katsuhisa Furuta [1][2][3][4] and his colleagues. The pendulum is underactutated and extremely non-linear due to the gravitational forces and the coupling arising from the Coriolis and centripetal forces. Since then, dozens, possibly hundreds of papers and theses have used the system to demonstrate linear and non-linear control laws.[5][6][7] The system has also been the subject of two texts.[8][9]
Despite the great deal of attention the system has received, very few publications successfully derive (or use) the full dynamics. Many authors [3][8] have only considered the rotational inertia of the pendulum for a single principal axis (or neglected it altogether [9]). In other words, the inertia tensor only has a single non-zero element (or none), and the remaining two diagonal terms are zero. It is possible to find a pendulum system where the moment of inertia in one the three principal axes is approximately zero, but not two.
A few authors [2][4][6][10][11][12] have considered slender symmetric pendulums where the moments of inertia for two of the principal axes are equal and the remaining moment of inertia is zero. Of the dozens of publications surveyed for this wiki only a single conference paper [13] and journal paper [14] were found to include all three principal inertial terms of the pendulum. Both papers used a Lagrangian formulation but each contained minor errors (presumably typographical).
The equations of motion presented here are an extract from a paper[15] on the Furuta pendulum dynamics derived at the University of Adelaide.
Consider the rotational inverted pendulum mounted to a DC motor as shown in Fig. 1. The DC motor is used to apply a torque to Arm 1. The link between Arm 1 and Arm 2 is not actuated but free to rotate. The two arms have lengths and . The arms have masses and which are located at and respectively, which are the lengths from the point of rotation of the arm to its center of mass. The arms have inertia tensors and (about the centre of mass of the arm). Each rotational joint is viscously damped with damping coefficients and , where is the damping provided by the motor bearings and is the damping arising from the pin coupling between Arm 1 and Arm 2.
A right hand coordinate system has been used to define the inputs, states and the Cartesian coordinate systems 1 and 2. The coordinate axes of Arm 1 and Arm 2 are the principal axes such that the inertia tensors are diagonal.
The angular rotation of Arm 1, , is measured in the horizontal plane where a counter-clockwise direction (when viewed from above) is positive. The angular rotation of Arm 2, , is measured in the vertical plane where a counter-clockwise direction (when viewed from the front) is positive. When the Arm is hanging down in the stable equilibrium position .
The torque the servo-motor applies to Arm 1, , is positive in a counter-clockwise direction (when viewed from above). A disturbance torque, , is experienced by Arm 2, where a counter-clockwise direction (when viewed from the front) is positive.
Before deriving the dynamics of the system a number of assumptions must be made. These are:
The non-linear equations of motion are given by [15]
and
Most Furuta pendulums tend to have long slender arms, such that the moment of inertia along the axis of the arms is negligible. In addition, most arms have rotational symmetry such that the moments of inertia in two of the principal axes are equal. Thus, the inertia tensors may be approximated as follows:
Further simplifications are obtained by making the following substitutions. The total moment of inertia of Arm 1 about the pivot point (using the parallel axis theorem) is . The total moment of inertia of Arm 2 about its pivot point is . Finally, define the total moment of inertia the motor rotor experiences when the pendulum (Arm 2) is in its equilibrium position (hanging vertically down), .
Substituting the previous definitions into the governing DEs gives the more compact form
and